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ABSTRACT 

The  governing  equations  for  constrained  multibody  systems 

.ire  formulated  in  i  war.  tie  ;*  suitable  ..v  their  automates,  nr/.,  .il 
development  and  solution.  Specifically,  the  "cioseo  loop"  p  rodent 
of  multibody  chain  systems  is  addressed. 

The  governing  equations  are  developed  by  modifying  dynamical 
equations  obtained  from  Lagrange's  form  of  d'Alembert's  principle. 
This  modification,  which  is  based  upon  a  solution  of  the  constraint 
equations  obtained  through  a  "zero  eigenvalues  theorem,"  is,  in 
effect,  a  contraction  of  the  dynamical  equations. 

It  is  observed  that,  for  a  system  with  n  generalized  coordinates 
and  m  constraint  equations,  the  coefficients  in  the  constraint 
equations  may  be  viewed  as  "constraint  vectors”  in  n-dimensional 
space.  Then,  in  this  setting  the  system  itself  is  free  to  move  in 


the  n-m  directions  which  are  "orthogonal"  to  the  constraint  vectors. 
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INTRODUCTION 


This  report  presents  a  formulation  of  the  governing  equations  of 
constrained  multibody  systems.  The  objective  is  the  establishment  of 
procedures  for  the  automated  generation  of  the  equations. 

Recently  there  has  been  an  increasing  interest  in  the  efficient 
development  of  governing  dynamical  equations  of  multibody  systems.  This 
interest  is  stimulated  by  the  fact  that  manv  physical  svstems  can  be 
r.io .  ...  j  :v.r  sys  cerr.s  >..’i  >  r.  ricct  •.?  c  n . "  itv.  '  *■  tv  .imon.i  ."..'.'w 
physical  svstems  of  interest  are  robots,  manipulators,  human  bodv  models 
and  biodynamic  systems,  rad  flexible  cables  or  '-bains. 

There  have  been  a  numoer  of  formulations  of  the  equations  of  motion 
of  multibody  systems  [1-19]*.  The  majority  of  these  have  been  restricted 
to  "open  chain"  or  "open  tree"  systems:  that  is,  systems  of  rigid  bodies 
such  that  adjacent  bodies  have  at  least  one  common  point  and  such  that 
no  closed  loops  are  formed.  Figure  1.  illustrates  such  a  system.  The 
formulation  of  the  governing  equations  of  motion  of  such  systems  has 
advanced  to  the  point  where  the  coefficients  of  the  governing  differential 
equations  can  be  formed  automatically  (numerically)  by  simply  knowing  the 
connection  configuration  [10-12] . 

However,  during  recent  years,  there  has  also  been  interest  in  the 
dynamics  of  systems  possessing  closed  loops,  where  some  of  the  branches 
of  the  tree  or  chain  are  connected.  Figure  2.  illustrates  such  a  system. 
These  svstems  are  useful  in  modelling  such  physical  systems  as:  closed 

*  Numbers  in  brackets  refer  to  References  at  the  end  of  the  report. 
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mechanisms,  "docking"  manipulators  of  spacecraft,  snip  cranes,  restrained 
human  body  models,  and  cables  anchored  at  both  ends. 

As  noted  above,  this  report  presents  a  procedure  for  the  automatic 
formulation  of  the  governing  equations  of  such  closed- loop  multibody 
systems.  The  procedure  is  based  upon  Lagrange's  form  of  d'Alembert's 
principle  as  exposited  by  Kane  et.  al.  [14,20-22]  and  as  used  in  [9-12] 
to  develop  the  dynamical  equations  of  motion.  It  is  also  based  upon  a 
"zero  eigenvalues  theorem"  as  exposited  by  Walton  and  Steeves  [23]  to 
provide  an  automatic  inclusion  in  the  analysis  of  the  constraint  equations 
The  balance  of  the  report  itself  is  divided  into  i v parts  with  the 
following  part  providing  some  preliminary  information  useful  in  the  sequel 
This  includes  a  review  of  dynamical  formulations  of  multiboiy  systems  and 
a  statement  of  the  "zero  eigenvalues  theorem."  This  is  followed  in  the 
next  part  by  the  governing  equation  formulation  for  constrained  or  closed- 
loop  multibody  systems.  The  subsequent  part  presents  a  simple  example. 

The  final  two  parts  discuss  generalizations  and  other  features  of  the 
formulation. 

PRELIMINARY  CONSIDERATIONS 

Coordinates  and  Kinematics 

Consider  again  the  multibody  system  of  Figure  1.  This  system  will 
have,  in  general,  3N+3  degrees  of  freedom  where  N  is  the  number  of  bodies 
of  the  system.  These  degrees  of  freedom  might  be  delineated  as  follows: 
Arbitrarily  select  a  body  of  the  system  as  a  reference  body.  Call  this 
body  B^.  Next,  label  or  number  the  remaining  bodies  of  the  system  in 
ascending  progression  away  from  B^  through  the  branches  of  the  tree 


structure,  moving  clockwise  from  branch  to  branch.  Then  the  orientation 

of  B,  relative  to  a  fixed  (inertial)  reference  frame  R  together  with  the 

orientation  of  the  remaining  bodies  of  the  system  relative  to  their 

adjacent  lower-numbered  bodies  defines  3N  degrees  of  freedom.  Finally, 

the  location  of  an  arbitrary  reference  point  in  relative  to  R  defines 

an  additional  3  degrees  of  freedom. 

The  position  and  configuration  of  the  system  can  thus  be  described  by 

3N+3  generalized  coordinates  x .  Let  y^  (1=1, . . . ,3N+3)  represent  their 

tine  derivatives*.  Next,  let  n^  (i=l,2,3'  represent  a  mutually  perpendicular 

.nit  vector  set  fixed  in  R.  Let  G,  represent  the  mass  center  of  oouv  B. 

k  ‘  i< 

(k=l,...,N).  Then,  it  has  been  shown  [20,21]  that  the  velocitv  of  G,  in  R 

rC 

and  the  angular  velocity  of  B  in  R  may  be  expressed  in  the  form: 


v,  =  v  v  n 
~k  kim 


and 


=  o 


y  n 

kim  I'm 


(1) 


(Regarding  notation,  a  repeated  index,  such  as  l  or  m  in  Equation  (1) 

represents  a  sum  over  the  range  of  that  index,  unless  otherwise  stated.) 

The  coefficients  v,  ,  and  ,  in  Equation  (1),  and  their  derivatives, 
klm  klm 

play  a  central  role  in  the  analysis  of  the  sequel.  They  are  components  of 
the  so-called  "partial  velocity"  and  "partial  angular  velocity"  vectors: 
)vk/9yi  and  3^^/3yr.  These  vectors  are  useful  in  forming  the  generalized 


*  The  reason  for  using  the  symbol  y?  instead  of  x^  is  that  there  exist 
instances  when  a  convenient  choice  of  generalized  coordinate  derivatives 
result  in  functions  vj  which  cannot  be  integrated  to  obtain  the  coordinate 
x  .  In  such  cases,  the  x  do  not,  in  general,  exist  (and  are  sometimes 

t  X. 

called  "quasi-coordinates").  This  occurs,  for  example,  when  the  y,  are 

v. 

selected  as  angular  velocity  components.  See  [24] . 
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accive  and  inertia  forces  of  the  system.  The  coefficients  v,  ,  and  ui,  , 

k-.n  klm 

and  their  derivatives  may  be  formed  by  simple  multiplication  algorithms 
as  developed  in  [9-12].  Hence,  by  differentiating  in  Equation  (1),  the 
acceleration  of  G  in  R  and  the  angular  acceleration  of  B,  in  R  may  be 

K.  K 

expressed  as: 


=  (v  y 
K  klmyl 


+  v.  „  y„)n  and  a,  =  (m,  ,  y„  +  u>,  .  y„)n  (2) 
klnr  J,  ~m  -k  kim  l  kJtm  l  ~m 


Equations  of  Motion 

Constcer  the  system  in  Figure  to  oe  subjectec  to  an  eucernar-^y 
applied  force  field  which  may  be  represented  on  a  typical  body  B,  by  a  single 
force  F^  passing  through  together  with  a  couple  with  torque  M^.  Similarly, 
let  the  inertia  force  system  on  be  represented  by  a  single  force  F* 
passing  through  together  with  a  couple  with  torque  M*.  Then  F*  and  M* 
may  be  expressed  as  [21] : 


-m,  a 
k.  k 


(no  sum) 


(3) 


and 


■h 


?k  '  tk  x  (h 


w.  )  (no  sum) 
k 


(4) 


where  is  the  mass  of  B^  and  1^  is  the  inertia  dyadic  of  relative  to 
G^.  Through  use  of  orthogonal  transformation  matrices  [10]  1^  may  be 
expressed  in  the  form: 


I.  =  I,  n  n 
-k  kmn~m~n 


(5) 


Lagrange's  form  of  d'Alembert's  principle  then  leads  to  governing 
dynamical  equations  of  motion  of  the  form  [21] : 
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F .  +  F* 


=0  l  =  1,. . . ,3N+3 


(6) 


wnere  r .  is  ca^ie- 


"lor.eralized  active  'orce"  and  may  >e  expressed  as: 


F  =  v  F  +  u  m 
i  k£m  km  kim  Tun 


(7) 


where  there  is  a  sum  from  1  to  S  on  k  and  from  1  to  3  on  m,  and  where 
F^  and  are  the  components  of  F^  and  Similarly,  F*,  in  Equation 

(6),  is  called  the  "generalized  inertia  force"  and  may  be  expressed  as: 


F*  =  v.  ,_F*  +  .  M*  (S) 

.<.v.  t\.  * v.r. 

where  there  is  a  sum  from  1  to  >i  on  k  and  from  1  to  3  on  n,  and  whe re 

F*  and  M*  are  the  n  components  of  F*  and  M* . 

Tern  ‘  -k  ~k 

Substituting  from  Equations  ■  1'  to  f'5)  into  (7)  and  i  :  1  an d 

finally  into  (6)  leads  to  the  equations  of  motion  which  may  be  written 
in  the  form [10] : 


'A'  q 


l  =  1, . . .  ,3i>3 


0) 


where  there  is  a  sum  from  1  to  3N+3  on  q  and  where  a,  and  f,  are  given  bv : 

M  q 


1 q  mk^k.'m'kqm  ^kmn  k<.m  kqm 


and 


f  =  F  -  (m.  v,  v,  y  +  I,  o,  ,  o, 
lc  km  kura  u  kmn  k.m  k 


v 

un'  u 


6nmh^kmr  J'kun  "ksr^k.  n’’  u' s 


(il) 


where  there  is  a  sum  from  1  to  N  on  k,  from  1  to  3N+3  on  u  and  s  and  from 


1  to  3  on  the  other  repeated  indices  and  where  e  , 

r  nmh 

tion  symbol  [25]. 


is  the  standard  permuta- 


Constraint  Equations 

Equations  (9)  represent  the  general  governing  dynamical  equations 
for  open  chain  or  open  tree  systems.  However,  if  the  system  has  one  or 
more  closed  loops,  as  illustrated  in  Figure  2.,  there  are  additional 
equations  which  need  to  be  satisfied  to  insure  that  the  closed  loops  are 
maintained  throughout  the  motion  of  the  system.  These  equations  are 
holonomic  constraint  equations  [21]  and  they  may  be  written  in  the  form: 

gf(x.)  =0  i  =  l,...,m  :  m  <  3\T+3  (12) 

(These  equations  may  be  obtained  by  simply  adding  to  zero  the  ralative 
position  vectors  of  the  connecting  joints  around  the  respective  loops.) 

It  should  be  noted  that  constraint  equations  of  the  form  of  Equation  (12) 

can  arise  in  ways  different  than  that  of  the  closed  loops  mentioned  above. 
This  can  occur,  for  example,  with  restrictions  on  the  motion  at  a  joint  or 
with  cne  anchoring  of  one  or  several  of  the  bodies  to  a  fixed  frame  R. 
Finally,  by  differentiating,  Equation  (12)  becomes  a  linear  relation  in  the 
y,  and  may  be  expressed  in  the  form: 

b^.y.  =  0  i  =  l,...,m;  i  =  l,...,3N+3  (13) 

where  the  b  are,  in  general,  functions  of  x,  and  t.  Equations  (9)  and 
(13)  thus  constitute  the  governing  equations  for  a  "closed-loop"  system. 
These  are  co  be  cast  into  a  solvable  form  in  the  sequel. 

Zero  Eigenvalues  Theorem 

For  a  constrained  N  body  chain  system,  the  n  dynamical  equations  (9) 
together  with  the  m  constraint  equations  (13)  constitute  n+m  equations  for 
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the  n  unknown  y.,  where  n  is  3N+3.  Hence,  the  system  is  over  determined. 

One  approach  to  overcoming  this  difficulty  is  to  solve  Equations  <M3) 

for  m,  say  the  last  m,  of  the  y,  in  terms  of  the  first  n-m  y_  as  "independent' 

C 

generalized  coordinate  derivatives,  the  partial  velocities  and  the  partial 
angular  velocities  can  be  expressed  exclusively  in  terms  of  these  y.  [21]. 
Finally,  by  following  the  procedure  suggested  by  Equations  (6),  (7),  and 
(8),  n-m  governing  dynamical  equations  are  obtained  for  the  y„  (1=1 , . . ,n-m) . 

Although  this  approach  is  suitable  for  relatively  small  systems, 
tiiicro  are  u ;  _  _  ^  n  .u  _*  s  in  lol'.-.  .  .  line,  1 1  '  k  sysrei'.s  —  Lir  [y  ,r. 

attempting  to  automate  it.  Among  these  di: .Lenities  is  the  problem  of 
obtaining  a  consistent  solution  ■  Equations  (13)  for  :r.  of  the  y.  in  terms 
of  the  remainin:  n-m  .  Another  lift  icul ty  is  the  problem  of  automatically 
eliminating  these  m  y,  from  the  partial  velocities  and  the  partial  angular 
velocities.  However,  in  1966,  while  working  on  a  constraint  problem  of  a 
different  context,  Walton  and  Steeves  [23]  developed  an  automated  procedure 
for  solving  equations  such  as  Equations  (13),  for  m  of  the  y,  in  terms 
of  the  remaining  independent  n-m  y,.  An  extension  of  their  procedure  can 
be  developed  to  automatically  eliminate  m  of  the  y,  from  the  martial  velocitv 
and  partial  angular  velocity  vectors.  Their  procedure  and  its  extension  are 
based  on  a  "zero  eigenvalues  theorem"  as  outlined  in  the  following  oaragraphs 

Consider  Equations  (13)  to  be  written  in  the  matrix  form  as: 

Bv  =  0  (14) 

where  3  is  an  mxn  rectangular  matrix  with  elements  b .  .  and  v  is  an  n 

i. 
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element  column  matrix  with  elements  v..  From  B  form  the  nxn  symmetric 
matrix  S  defined  ns: 


S  =  B1  B 


(15' 


where  B1  is  the  transpose  of  B.  Since  S  is  symmetric,  there  exists  an 
orthogonal  matrix  T  such  that: 

TTST  =  A  (16) 

where  ..  an  nxn  Jiaaonai  matrix  with  real  elements  or  "eigenvalues1' 

‘  .  (i  =  l,...,n)  [26],  These  eigenvalues  are  readily  seen  to  be  non-negative 

T  t  7 

as  rollows:  Let  v  be  a  typical  column  of  1  and  let  w  be  Bv.  Then  w  w  =  v'B  8v  = 

T  y  .7 

"  s'v.  But  w  _  0,  and  by  Equation  (16),  v  Sv  is  seen  to  be  an  element  or 

A,  say  \^.  Hence,  \  _>  0.  It  is  also  readily  seen  that  there  exist  zero 

eigenvalues:  Since  B  is  an  m x n  matrix,  its  rank  is  less  than  or  equal 
to  m  (26] .  Then,  bv  Equation  (15),  the  rank  of  S  is  also  less  than  or  equal 
to  m.  But,  since  m<n  the  rank  of  the  nxn  matrix  S  is  less  than  n. 

Let  the  columns  of  T  in  Equation  (16)  be  arranged  so  that  the  eigen¬ 
values  of  S,  or  the  diagonal  elements  of  ,  are  ordered.  That  is.  arranse 

T  such  that  '>  >  '•  >  ...  '■  '•  .  (From  the  preceeding  argument,  the  last  r> 

1  —  c  —  —  n 

of  these  will  be  zero,  where  p  _>  n-n.)  Next,  let  the  mxn  matrix  D  be 
defined  as: 

D  =  BT  i 17) 

Then,  from  Equations  (15)  and  (16)  it  is  seen  that: 

DTD  =  A  (13) 


i 

5 

3 

i 


1 


i 

i 

| 

i 

l 

| 
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Hence,  since  Che  last  p  rows  (and  columns)  of  A  are  zero,  C  may  be  written 
i.n  the  partitioned  form: 

D  =  [Dj  0]  (19) 

where  D  is  an  (n-p)x(n-p)  matrix  with  mutually  orthogonal  columns,  and 

T 

where  n-m  <_  p  <  n.  By  noting  that  TT  is  the  nxn  identity  matrix,  the 
constraint  equation  (14)  may  be  written  as: 

Dy  =  DTTTy  =  DTz  =  0  (20) 

where  z  is  the  n  element  column  matrix  defined  as  Tiv.  In  view  of  Equation 
(19),  the  final  equality  in  Equation  (20)  is  satisfied  if  the  first  n-p 
elements  of  z  are  zero,  irrespective  of  the  values  o:  the  last  p  elements 
of  z. 

Since  T  is  orthogonal,  the  definition  in  Equation  (20)  may  be 
"inverted"  leading  to  the  expression: 

y  =  Tz  (21) 

However,  since  the  first  n-p  elements  of  z  are  zero,  y  may  be  rewritten  as: 

v  =  Tz  (22) 

where  T  is  the  nxp  matrix  whose  columns  are  the  last  p  columns  of  T. 

(In  view  of  the  ordering  defined  above,  these  columns  are  the  columns  of  T 
associated  with  the  zero  eigenvalues  of  S.)  Thus,  Equation  (22)  provides 
a  solution  to  Equation  (14)  for  the  n  y ,  in  terms  of  the  n  independent  (the 
last  p)  elements  of  z.  Moreover,  Equation  (22)  is  an  "algorithmic" 
expression  in  that  standard  numerical  procedures  exist  for  matrix  diagonal- 
ization,  eigenvalue  determination,  and  hence,  for  the  numerical  evaluation 
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of  che  nxp  matrix  T. 


In  index  notation,  Equation  (22)  may  be  '.Tic ten  as: 

y-  =  t.rzr  '  =  L ..... r. ;  r  =  1 . .  (23) 

where  the  t  may  be  thought  of  as  components  of  the  column  eigenvectors 

t  in  n  dimensional  space. 

Finally,  the  formal  statement  of  Equation  (22)  constitutes  the  "zero 
eigenvalues  theorem"  [23] . 


GOVERN ING  EOUA 1  LONS 


The  procedures  outlined  above  can  be  used  to  systematically  formulate 
the  solution  to  the  multibody  system  dynamics  equations  (9)  subject  to  the 
constraint  equations  (13).  To  develop  this  formulation,  consider  again  the 
partial  velocity  and  partial  angular  velocity  vectors  discussed  above. 

From  Equations  (1)  and  (23)  the  velocity  of  in  R  and  the  angular  velocity 
of  in  R  may  be  expressed  in  the  form: 


v,  =  v,  t  ,  z  n  and  . ,  =  ...  ,  t  .  z  n 

~k  k-.m  ,r  r~m  'k  k-m  . r  r~m 


(24) 


where  the  z^_  (r=l,...,p)  may  be  viewed  as  new  generalized  coordinate 

derivatives.  The  partial  velocity  of  in  R  and  the  partial  angular 

velocitv  of  3,  in  R,  with  respect  to  z  ,  then  become: 
k  r 


Hence , 


V’zr 


v,  t  ,  n 
k>m  '.r~m 


and 


lu..  /  )  z  =  c  t ,  n 
~k  r  k- m  • r-m 


the  generalized  active  and  inertia  forces  of  Equations 


(25) 

(7)  and 


*  a 
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(8)  become: 


"  =  ■’  t  F  cM 

r  k;m  ir  km  kirn  Ir  km 


F*  =  v,  .  t ,  F*  +  o.  ,  t ,  M* 
r  k.a  Ir  km  k’.m  ’ r  km 


Then,  from  Lagrange's  form  of  d'Alembert's  principle,  the  governing 
equations  (6)  become: 


F*  =  0  r  =  1 , . .  .  ,  p 


or,  more  specifically; 


:  ■•  =  r  ,  t  . 

o  or  -  ■  r 


r  =  1 . r 


where  a,  and  f,  are  given  by  Equations  (10)  and  (11). 

«.  CJ  ^ 

Equations  (29)  together  with  the  constraint  equations  (13)  constitute 
the  system  of  equations  to  be  solved.  A  numerical  procedure  for  their 
solution  can  be  formulated  as  follows:  Consider  the  general  case  where  p=n-m. 
Then,  by  differentiating,  the  constraint  equations  (13)  become: 


b  V  “  —  b  V 

i  •  ■  ■  i  ' 


i  =  1 , .  .  .  ,  m 


Equations  (29)  and  (30)  form  a  total  of  n  equations  for  the  2n  unknowns 

y,  and  x,.  Hence,  there  needs  to  be  annexed  to  these  equations  the  expressions: 


for  the  consistent  numerical  formulation  of  the  governing  equations.  (If 
the  y  are  chosen  such  that  the  x  do  not  exist,  as  mentioned  earlier. 
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chen  Equations  (11)  must  be  replaced  by  analogous  expressions  relating 
v  to  other  variables  (such  as  Euler  parameters  [10J  vhicn  define  the 
relative  orientations  of  the  bodies.) 

The  balance  of  the  numerical  formulation  of  the  solution  of  Equations 
(29),  (30),  and  (31)  is  now  routine:  It  is  perhaps  must  convenientlv 
expressed  in  matrix  notation.  To  this  end,  let  C  be  the  nxn  matrix 
containing  the  coefficients  of  y  in  Equations  (29)  and  (30).  Then,  in 
partitioned  form  C  is: 


where  x  and  y  are  the  column  matrices  with  elements  x  and  v,  ( .’  -  l,...,u) 
respectively. 
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example 


For  a  simple  example  illustrating  some  ol  these  ideas,  consider  the 
planar  triple  pendulum  shown  in  Figure  3.  The  three  rods  are  identical 
having  length  •,  and  there  are  trie cionless  pins  at  the  joints:  0^,  09, 
and  0^.  The  system  has  3  degrees  of  freedom  which  may  be  described  by 
the  orientation  angles  0  ,  90,  and  9^  shown  in  the  figure.  Using  Lagrange's 
form  of  d'Alembert's  principle,  the  equations  of  motion  of  the  system 


U  -  -  18.;  ,  *  60,  +  6C9+3)-'1  +  <  !0  +  90,  ^  603  +  3C9+J'-  ■ , 
+  (3  +  3C3  +  .-J  =  -(g/O  (15S1  +  9S1+2  +  3S1+3+3) 

-  (9S9  +  3S2+3)9“  +  (9S2  -  3S3)(§1  +  92>2 


+ 


( 3S 


2+3 


3S  3)  ( 


and 


(10  *  90,  +  60,  +  30o ,  ,)  -1 ,  +  (10  +  60-,)%  +  (2  +  3C.)-„ 
>  J 3  1  32  3  a 


=  - (g/ > ) (9S 3+,  +  381+3+3)  -  (9S9  +  3S2+3)9“ 
-  3S3Ol  +  9,)2  +  3S3(91  +  92  +  03)2 


(36) 


(2  -  30,  +  30,, , ,)1,  +  (2  +  3C,)0,  +  29. 


'3  2+3  '1 


y  2  3 


3(g/  +  -  “  3S 3 ( ^ ^  ^ 


(37) 


where  C.  =  cos6 . ,  C...  =  cos (9.  +  9.),  etc. 
l  i  i+j  t  3 
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A  "closed  loop"  or  constraint  mav  be  formed  by  fixing  the  end  point 
P  of  the  pendulum.  Hence,  let  P  be  fixed  at  a  point  having  coordinates 
(a,b)  relative  to  the  X-Y  coordinate  system  shown  in  Figure  3.  This 
constrained  system  has  only  one  degree  of  freedom.  Two  scalar  constraint 
equations  relating  the  coordinates  S^,  and  maY  be  obtained  from  the 

position  vector  equation: 


0,0„  +  0-0-  +  0,P  +  P  0.  =  0 

12  23  3o  o_  l 

That  is,  considering  the  horizontal  ar.c 

equation  leads  to  the  equations: 


(38) 


iiciits  or  tnis 


SL  ~  3 1+2  +  H 1-2+3  a/< 


(39) 


'1  ^1+2  1+2+3 


=  b/l 


which,  upon  differentiation,  become: 


+  cl+2  +  Cl+2+3,5l  +  <C1«  +  Cl+2+3,52  +  Cl+2+353  *  0 
<S1  +  Sl+2  +  Sl+2+3):‘l  +  <Sl+2  +  S!+2+3)e2  +  Sl+2+3'3  “  0 


(40) 


Equations  (39)  and  (40)  represent  Equations  (12)  and  (13)  in  the  foregoing 
analysis. 

To  simplify  the  analysis,  let  P  be  fixed  on  the  X-axis  at  a  point  Pq 
a  distance  ?.  from  0^  The  system  then  takes  the  form  of  a  rhombic  linkage 
as  shown  in  Figure  4.  In  this  case,  a=i,  b=0,  and  the  constraint  equations 
(39)  are  seen  to  be  satisfied  by  the  relations:  90  =  t / 2— 9 ^  and  3^  =  t/2+~i^. 
The  coefficient  matrix  B  of  Equations  (13)  and  (40)  may  then  be  expressed  as; 
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1  (1 

— 


-  V 


The  matrix  S  of  Equation  (15)  then  becomes: 


1  (1  -  sx)  -s1 

S  =  (1  -  S1)  2(1  -  Sx)  (1  -  SL) 

-s1  (1  -  S j)  1 


It  is  readily  seer,  that  S  has  one  zero  eigenvalue  and  that  the  associated 
eigenvector  array  T  is: 

rf, 


T  -  -1 


The  governing  equations  to  be  solved  may  now  be  obtained  using  Equations 
(29)  and  (30).  From  Equations  (35),  (36),  (37),  and  (40),  these  become: 


(16  +  9C?  +  3C.  +  6C2+3)ex  +  (2  +  9C,  +  3C3  +  3C7+3)92 


+  (2  +  3C2+3)e3  =  -(g/i)(15S1  +  3S1+2+3)  -  3S2+301 
+  (9s2  -  3s3)(01  +  e2)2  +  3s2+3(§1  +  e2  +  B 3> 2 


"Cie2  "  C1S3  =  Sl'l62  +  Siei?3 


9,  -  (i  -  s1)e2  -  Sl93  =  -C1510?  -  0,0,0. 


'11  3 
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Equations  (44),  (45),  and  (46)  have  been  solved  numerically.  The 


results  :natch  the  results  or  the  numerical  solution  of  the  pendulum 
equation: 

•3^  +■  (bg/SOsin^  =  0  (47) 

which  is  the  governing  equation  of  the  rhombic  linkage  of  Figure  4. 


REDUCTION  OF  THE  NUMBER  OF  GOVERNING  EQUATIONS 

A  principal  step  in  the  foregoing  formulation  as  well  as  in  the  above 
example  is  the  differentiation  of  the  constraint  equations  (See  Equations 
(36),  (45),  and  (46).).  Since  these  equations  are  then  combined  with  the 
reduced  set  of  dynamical  equations  and  the  resulting  system  is  integrated, 
a  question  which  arises  is:  Is  it  necessary  to  first  differentiate  and 
later  integrate  these  equations?  That  is,  could  some  computational 
efficiency  be  obtained  by  avoiding  the  differentiation-integration  steps? 
The  answer  to  these  questions  is  that  it  is  indeed  possible  to  integrate 
fewer  equations  and  thus  obtain  some  computational  advantages.  A  procedure 
demonstrating  this  is  outlined  in  the  following  paragraphs: 

Let  the  mxn  matrix  B  in  Equation  (14)  be  partitioned  into  two 
submatrices  as : 

B  =  [B  :  BJ  (48) 

a  '  b 

where  B  is  an  m x  (n-m)  arrav  and  B,  is  an  m x m  square  arrav.  This 
a  b 

partitioning  of  B  induces  a  partitioning  of  the  v  array  in  Equation  (30). 
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That  is,  if  Equation  (30)  is  written  in  the  matrix  form  as:  Bv  =  -By, 


then  By  may  be  expressed  as: 

r 

j  y  ! 

By  =  [Ba  !  V  IrM  -  -B>- 


where  v  is  a  column  arrav  with  n-m  elements  and  y,  is  a  column  arrav  with 
a  b 

m  elements.  If  B  ^  exists.  Equation  (49)  may  be  solved  for  y  in  the  form: 
b  b 


yb  =  “Bb  (Baya  +  By>  (50) 

Similarly,  let  the  reduced  set  of  dynamical  equations  (29)  be  writ  tan 

in  the  matrix  form  Av  =  f  where  A  is  the  (n-m)xm  arrav  with  elements  c  a 

rq  a 

r=l,,,.,n-m;  n  and  f  is  the  column  arrav  with  elements  f  t, 

..  '  r 

r=l,...,n-m.  Then  following  the  pattern  of  Equations  (48)  and  (49),  let 
the  dynamical  equations  be  written  in  the  partitioned  form: 


tAa  i  ‘V 


I—  — 
* 

ya 

•  i 


where  A^  is  an  (n-m)x(n-m)  square  array  and  is  an  (n-m)  xm  array. 

By  substituting  from  Equations  (50)  and  by  matrix  block  multiplication 
Equation  (51)  becomes: 


A  y  +  A,  [— B  (B  v  +  Bv)]  =  f 
a  a  b  baa  - 


By  rearranging  the  terms,  this  equation  may  be  written  as: 


Ay  a  =  f 


where  A  is  the  (n-m)  x  (n-m)  square  array  defined  as: 
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(54) 


and  f  is  the  (n-m)  element  column  array  defined  as: 

f  =  f  +  A^B^Bv  (55) 

b  b 

Equation  (53)  is  equivalent  to  a  system  of  (n-m)  scalar  differential 
equations  containing  2n  unknowns:  y^  and  x^ ,  £=l,...,n.  Hence,  there 
needs  to  be  annexed  to  this  system  an  additional  n+m  scalar  equations. 
Equation  (31)  provides  n  of  these  equations.  In  matrix  form  they  may  be 
written  as: 


x  = 


y 


(56) 


The  final  m  equations  may  be  obtained  from  Equations  (50).  However,  unlike 
Equations  (53)  and  (56) ,  Equations  (50)  are  algebraic  equations  and  do  not 
need  to  be  integrated.  That  is,  the  system  of  2n  equations  of  Equations 
(501,  (53),  and  (56)  contain  2n-m  differential  equations  and  m  algebraic 
equations  for  the  2n  unknowns  v„  and  x„ ,  H=l,...,n.  This  is  a  reduction  of 
m  differential  equations  from  the  previous  system  of  Equations  (29),  (30), 
and  (31). 


DISCUSSION 

k. 

! 

•»  | 

At  this  point  there  are  several  comments  and  observations  which  might 

be  helpful.  First,  in  the  procedure  of  the  cere  eigenvalues  theorem,  the 

t 

m  constraint  equations  are  solved  for  the  n  y ^  in  terms  of  n-m  new  variables 

z  .  Interestingly,  in  the  subsequent  formulation  of  governing  equations, 

%  r 

these  new  variables  z  do  not  appear.  Indeed,  it  is  onlv  the  coefficients 
■i 

«  ; 

- 
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t,  of  the  z  which  are  used.  As  noted  earlier,  these  coefficients  are  the 
components  in  n-aimensional  space  of  the  eigenvectors  t  associated  with  trie 
zero  eigenvalues  of  S.  However,  in  this  context,  since  the  corresponding 
eigenvalues  are  zero,  St^  is  zero  and  the  eigenvectors  tf  are  thus 
"orthogonal"  to  the  rows  of  S.  This  in  turn  means  that  these  eigenvectors 
are  orthogonal  to  the  rows  of  the  constraint  matrix  B.  (This  conclusion 
was  also  reached  in  an  earlier  analysis  of  constraint  equations  in 
n-dimensional  space  [27].)  Hence,  let  the  rows  of  B  be  thought  of  as 
"constraint  vectors"  in  n-i i~en?ionai  snace.  Then,  since  the  t  are  used 

■-V 

to  form  the  new  partial  veiocitv  and  partial  angular  velocity  vectors,  the 
physical  system  can  be  -onsidered  to  be  constrained  to  move,  in  n- dimension..! 
snace,  in  directions  orthogonal  to  these  constraint  vectors  —  that  is. 
in  directions  defined  by  the  eigenvectors  t^. 

Next,  Lagrange's  form  of  d'Alembert’s  principle  is  an  ideally  suited 
method  for  formulating  the  dynamical  equations  when  there  are  accompanine 
constraint  equations.  Indeed,  the  governing  differential  equations  may  be 
developed  by  simply  contracting  the  dynamical  equations  obtained,  via  the 
principle,  by  using  the  t.,_  arrav  obtained  from  the  zero  eigenvalues  theorem 
This  procedure  is  seen  to  be  successful  since  the  generalized  forces  are 
linear,  homogeneous  functions  of  the  partial  velocity  and  angular  velocity 
vectors,  which  in  turn,  are  coefficients  of  the  generalized  coordinate 
derivatives  (in  the  veiocitv  and  angular  velocity  vectors'!.  Therefore,  a 
modification  of  these  derivatives  directly  changes  these  vectors  and  hence, 
also  the  generalized  forces.  This  means  that  the  modification  procedure 
for  the  generalized  coordinate  derivatives,  as  developed  by  the  zero  eigen¬ 
values  theorem,  may  be  directly  applied  to  the  dynamical  equations  them- 
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solves.  Also,  due  Co  these  arguments,  it  is  seen  that  cnis  procedure  would 
not  necessarily  be  successful  if  the  dvnamical  equations  were  obtained  by 
some  ocher  method.  (Additional  discussion  of  the  merits  of  Iterance's  form 
of  d'Alembert's  principle  may  be  found  in  references  [10,11,20,21,11].; 

Finally,  the  procedure  developed  herein  is  deemed  to  be  well  suited 
for  the  automated  development  of  the  governing  equations.  Numerical 
algorithms  are  currently  being  prepared  to  be  incorporated  into  the  computer 
codes  discussed  in  [10,11,12].  Additional  information  on  this  may  be 


ACKNOWLEDGEMENT 

The  authors  gratefully  acknowledge  partial  support  for  this  research 
from  the  Office  of  Naval  Research  under  Contract  N00014-76C-0139 .  The 
authors  also  gratefully  acknowledge  several  helpful  suggestions  of  Dr. 
Chris  Passerello  of  Michigan  Technological  University. 


N. 


REFERENCES 


1.  Sayazitcglu,  Y.  A.,  and  Chace,  M.  A.,  "Methods  of  Automated  Dynamic 
Analysis  of  Discrete  Mechanical  Systems,"  ASME  Journal  of  Applied 
Mechanics ,  Vol.  40,  1973,  pp.  809-819. 

2.  Chace,  M.  A.,  "Analysis  of  the  Time  Dependence  of  Multifreedom 
Mechanical  Systems  in  Relative  Coordinates,"  ASME  Journal  of  Engineering 
for  Industry,  Vol.  89,  1967,  pp.  119-125. 

3.  Chace,  M.  A.,  and  Bayazitoglu,  Y.  0.,  "Development  and  Application  of 
a  Generalized  d'Alembert  Force  for  Multifreedom  Mechanical  Systems," 

ASME  Journal  of  Engineering  for  Industry,  Vol.  93,  1971,  pp.  317-327. 

4.  Gupta,  V.  K. ,  "Dynamic  Analysis  of  Multirigid-Body  Svstems,"  ASME 
journal  of  Engineering  for  Industry,  Vol.  96,  1974,  on.  386-892. 

5.  Hollerback,  J.  M. ,  "A  Recursive  Lagrangian  Formulation  of  Manipulator 
Dynamics  and  a  Comparative  Study  of  Dynamics  Formulation  Complexity." 

IEEE  Transactions.  Svstems,  Mar.,  and  Cybernetics,  Vol.  SMC- 10,  1980, 
pp.  730-736. 

6.  Hooker,  W.  W.  ,  and  Margulies ,  G.  ,  "The  Dynamical  Attitude  Equations 

for  an  n-Body  Satellite,"  Journal  of  the  Astronautical  Sciences,  Vol.  12, 
1965,  pp.  123-128. 

7.  Hooker,  W.  W, ,  "A  Set  of  r  Dynamical  Attitude  Equations  for  an 
Arbitrary  n-Body  Satellite  Having  r  Rotational  Degrees  of  Freedom," 

AIAA  Journal,  Vol.  8,  1970,  pp.  1205-1207. 

8.  Hooker,  W.  W. ,  "Equations  of  Motion  for  Interconnected  Rigid  and 
Elastic  Bodies,"  Celestial  Mechanics,  Vol.  11,  1975,  pp.  337-359. 

9.  Huston,  R.  I..,  and  Passerello,  C.  E. .  "On  the  Dynamics  of  Chain  Svstems," 
ASME  Paper  No.  74-WA/Aut  11,  1974. 

10.  Huston,  R.  L. ,  Passerello,  C.  E.,  and  Harlow,  M.  W. ,  "Dynamics  of  Multi- 
Rigid-Body  Systems,"  ASME  Journal  of  Applied  Mechanics,  Vol.  45,  1978, 
pp.  889-894. 

11.  Huston,  R.  L. ,  and  Passerello,  C.  E.,  "On  Multi-Rigid-Body  System 
Dynamics,"  Computers  and  Structures,  Vol.  10,  1979,  pp .  439-446. 

12.  Huston,  R.  L. ,  and  Passerello,  C.  E. ,  "Multibody  Structural  Dynamics 
Including  Translation  Between  the  Bodies,"  Computers  and  Structures, 

Vol.  12,  1980,  pp.  713-720. 


-  -  "  - 


25 


13.  Jerkovskv,  W. ,  "The  Transformation  Operator  Approach  to  Multisystems 
Dynamics,  Part  I:  The  General  Approach,"  Matrix and  Tensor  Quarterly. 

Vol .  27,  1976,  pp.  48-59. 

1-.  Kane,  T.  R.  ,  and  Levinson,  D.  A.,  "Formulation  of  Equations  of  Motion 
for  Complex  Spacecraft,"  Journal  of  Guidance  and  Control,  Vol.  3, 

1980,  pp.  99-112.  ""  . . ~~  . . 

15.  Orin,  D.  E.  ,  McGhee,  R.  B.,  Vukobratovic ,  M. ,  and  Hartoch,  G. , 

"Kinematic  and  Kinetic  Analysis  of  Open-Chain  Linkages  Utilizing 
Newton-Euler  Methods,"  Mathematical  Biosciences,  Vol.  43,  1979,  pp. 

107-130. 

16.  Stepanenko,  Y. ,  and  Vukobratovic,  M. ,  "Dynamics  of  Articulated  Open 
Chain  Active  Mechanisms,"  Mathematical  Biosciences.  Vol.  28,  1976, 

pp.  137-170. 

1  ■  .icicer,  J.  .i  .  ,  r,  ,  Jyr.amicc  l  Je.i.i.r  ■  r  oi  Spatial  Lr nivuges,  . vo . la 
Journal  of  Engineering  for  Industry,  Vol.  91,  1969,  pp.  251-265. 

18.  Vukob rate vre,  M. ,  "Computer  Method  for  Dynamic  Model  Construction  of 
Active  Articulated  Mechanisms  Using  Kinetos  rati  a  .reproach,"  Mechanism 
and  Machine  Theory,  Vol.  13,  1978,  pp.  19-39. 

19.  Wittenburg,  J.,  Dynamics  of  Systems  of  Rigid  Bodies,  B.  G.  Teubner, 
Stuttgart,  1977. 

20.  Kane,  T.  R. ,  "Dynamics  of  Nonholonomic  Systems,"  ASME  Journal  of  Applied 
Mechanics ,  Vol.  28,  1961,  pp.  574-578. 

21.  Kane,  T.  R. ,  Dynamics ,  Holt,  Rinehart,  and  Winston,  New  York,  1968. 

22.  Huston,  R.  L. ,  and  Fasserello,  C.  E. ,  "On  Lagrange's  Form  of  d'Alembert's 
Principle,"  Matrix  and  Tensor  Quarterly,  Vol.  23,  1973,  pp.  109-112. 

23.  Walton,  W.  C.,  Jr.,  and  Steeves,  E.  C.,  "A  New  Matrix  Theorem  and  Its 
Application  for  Establishing  Independent  Coordinates  for  Complex 
Dynamical  Systems  with  Constraints,"  NASA  Technical  Report  TR  R-326, 
October,  1969. 

24.  Kane,  T.  R. ,  and  Wang,  C.  F. ,  "On  the  Derivation  of  Equations  of 
Motion,"  Journal  of  the  Society  for  Industrial  and  Applied  Mathematics, 

Vol.  13,  1965,  pp.  487-492. 

25.  Brand,  L. ,  Vector  and  Tensor  Analysis,  Wiley,  1947. 

26.  Ayres,  F. ,  Jr.,  Matrices ,  Schaum's  Outline  Series,  McGraw  Hill,  1962. 

27.  Huston,  R.  L. ,  and  Passerello,  C.  E.,  "On  Constraint  Equations  -  A  New 
Approach,"  ASMF.  Journal  of  Applied  Mechanics,  Vol.  41,  1974,  op.  1130-1131. 


26 


ScCU  ^1  •  iWll 


REPORT  DOCUMENTATION  PAGE 


II.  GOVT  *cc 


-MIS-080181-12 


-f)!0  3  0 


4*  ^  ;'4/I <3  SuOtltl*) 


Multibody  System  Dynamics  with  Constraints : 
The  "Ciosec  Loco"  Problem 


SEA 3  rNSTRUCl  l(jfi  3 
BEFORE  CCMPLETTNO  FORM 


-■-3E  0*  RE3CRT  4  RE'VCO  ZZ.ZtZZ 


I  Technical  "/ 31.'  80-8/ 1.  8 1 

I  6.  PSRrO^MnG  CrtO. 


au  T^c«r4> 

Janes  rJ.  Karrman 
Ronald  L.  Huston 


PERFORMING  ORGANIZATION  SAME  ANC  AOCRESS 

University  of  Cincinnati 
Cincinnati,  Ohio  45221 


«wN  ■  14%.  .■*  w.Un’  HwMa 


i  N00014-76C-0139 


'0.  program  i.jMi.s r.  pro, etc.  -ag„ 
AREA  4  »03<  UNIT  NUMBERS 


122303 


12.  REPORT  OATS 

8/1/81 


u.  number  op  pages 

26 


17.  OISTRIBUTION  STATEMENT  (of  :A«  eOetreel  entered  In  Block  JO,  it  different  /root  Report) 


KEY  WORDS  (Continue  an  reeetee  tide  II  neceeeery  and  identity  by  Otoe*  number ) 

Constraint  Equations,  Finite-Segment  Modelling,  Closed  Chains, 
Dynamics,  Multi-Body  Systems. 


20.  ABSTRACT  (Continue  an  reeeree  tide  It  neceeeory  and  Identify  by  block  number) 

The  governing  equations  for  constrained  muitibed’-  systems  are  formulated  in  a 
manner  suitable  for  their  automated,  numerical  development  and  solution.  Soecifi- 
oaliy,  the  "closed  loon"  problem  of  multibody  chain  systems  is  addressed. 

The  governing  equations  are  developed  by  modifying  dynamical  equations  obtained 
from  Lagrange’s  form  of  d’Alembert’s  principle.  This  modification,  which  is  basec 
uoon  a  solution  of  the  constraint  equations  obtained  through  a  "zero  eigenvalues  j 
theorem,"  is,  in  effect,  a  contraction  of  the  dynamical  equations. 


DO  1  j an*73  1473  EDITION  OP  1  NOV  SS  I]  OBSOLETE 
S/ft  1 102*0  24*  140 1  I 


SECURITY  CLASSIFICATION  OF  this  page  (■Wh.n  Beta  tntoeod) 


20. 


ABSTRACT  (Continued) 


It  is  observed  that,  for  a  system  with  n  generalized  coordinates 
and  m  constraint  equations,  the  coefficients  in  the  constraint  equations 
may  be  viewed  as  "constraint  vectors"  in  n-dimensional  space.  Then,  in 
this  setting  the  system  itself  is  free  to  move  in  the  n-m  directions 
which  are  "orthogonal"  to  the  constraint  vectors. 


